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01.10.02 Ms 

ROBERT BOSCH GMBH, 70442 Stuttgart 

Verfahren und Vorrichtung zur Ermittlung des Schwimmwinkels eines Kraftfahrzeugs 
Stand der Technik 

Die Erfindung betrifft ein Verfahren und eine Vorrichtung zur Bestimmung des 
Schwimmwinkels eines Kraftfahrzeugs. 

Aus der DE 100 08 550 A 1 sind ein Verfahren und eine Vorrichtung zur Bestimmung 
eines Bewegungsparameters eines Kraftfahrzeuges bekannt, wobei eine Steuerung zur 
Bestimmung insbesondere des aktuellen Geschwindigkeitsvektors und dem Winkel 
zwischen der Fahrzeuglangsachse und dem Geschwindigkeitsvektor (Schwimmwinkel) 
unter Hinzuziehung eines Differenz-Navigati on s systems (D-GPS) verwendet wird. Da 
das Differenz-Navigationssystem (D-GPS) erheblich genauere Positionsdaten liefert als 
ein in Kraftfahrzeugen eingesetztes ,normales' Navigationssystem, kann auch die 
Bestimmung des Geschwindigkeitsvektors des Kraftfahrzeugs mit groBerer Genauigkeit 
erfolgen. Dieses kann insbesondere auf glatter Fahrbahn, wenn das Kraftfahrzeug ins 
Schleudern gerat oder die Messdaten des Radsensors nicht mehr zuverlassig sind, 
relevant sein. In weiterer Ausgestaltung ist vorgesehen, dass die vom Navigationssystem 
gelieferten Daten auch zur Kontrolle und Uberwachung der Sensordaten herangezogen 
werden. Bei Uberschreitung eines vorgegebenen Grenzwertes kann eine entsprechende 
Fehlermeldung ausgegeben werden. 

In der DE 199 45 1 19 Al wird ein Verfahren zum Navigieren eines bodengebundenen 
Fahrzeugs angegeben, bei dem eine Weglangengrofie mit Hilfe der Umdrehungszahl 
eines Rades gemessen wird. Hierbei mochte man genauere Grundlagen fur die Navigation 
verwenden konnen. Die WeglangengroBe wird mit Hilfe von mindestens einem extern en 
Positionsgeber kalibriert. 
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Aus der DE 197 48 127 A 1 ist eine Navigationseinrichtung fur Kraftfahrzeuge bekannt, 
bei der neben anderen Ortsbestimmungsverfahren auch Koppelortung angewendet wird. 
Dabei ist zur Wegmessung fur die Koppelortung ein vorzugsweise in die 
Navigationsrichtung eingebauter Beschleunigungssensor vorgesehen, dessen 
5 Ausgangssignal zweimal integriert wird. AuBerdem kann zur Kursbestimmung fur die 

Koppelortung ein Drehratensensor vorgesehen sein. 



Die Merkmale der Oberbegriffe der unabhangigen Anspriiche gehen aus der DE 1 00 08 
550 A 1 hervor. 

10 

Vorteile der Erfindung 



Die Erfindung geht aus von einem Verfahren zur Ermittlung des Schwimmwinkels eines 
Kraftfahrzeugs, bei dem durch einen Gierratensensor die Gierrate des Kraftfahrzeugs 
15 ermittelt wird. 

Der Kern der Erfindung besteht darin, dass 

die Richtung der Geschwindigkeit insbesondere im Schwerpunkt des Kraftfahrzeugs 

durch eine Frequenzanalyse der durch einen im Kraftfahrzeug befindlichen GPS- 

Empfanger empfangenen Signale ermittelt wird und 
20 - abhangig wenigstens von der Gierrate und der Richtung Geschwindigkeit des 

Kraftfahrzeugs der Schwimmwinkel ermittelt wird. 
Der Vorteil dieser Ermittlungsart besteht in ihrer hohen Genauigkeit, da das GPS-System 
die Fahrzeuglangsgeschwindigkeit sowie deren Richtung mit einer sehr hohen Prazision 
ermittelt. 

25 

Eine vorteilhafte Ausfuhrungsform ist dadurch gekennzeichnet, dass 
aus der Qber den GPS-Empfanger ermittelten Geschwindigkeit eine 
Winkelgeschwindigkeit ermittelt wird und 

die Winkelgeschwindigkeit in die Ermittlung des Schwimmwinkels eingeht. 
30 Durch die Ermittlung der Winkelgeschwindigkeit steht eine GroBe zur Verfligung, 

welche dieselbe physikalische Dimension wie die Giergeschwindigkeit aufweist und 
dadurch mit dieser auf einfache Weise verkniipft und verglichen werden kann. 
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Eine vorteilhafte Ausgestaltung ist dadurch gekennzeichnet, dass die 
Winkelgeschwindigkeit die Drehgeschwindigkeit des die Geschwindigkeit 
beschreibenden Vektors beschreibt. Die Kenntnis der Drehgeschwindigkeit des die 
Geschwindigkeit beschreibenden Vektors vereinfacht die Bestimmung des 
Schwimmwinkels erheblich. 

Eine weitere vorteilhafte Ausfuhrungsform ist dadurch gekennzeichnet, dass 

die Differenz zwischen der Gierrate und der Winkelgeschwindigkeit ermittelt wird 
und 

der Schwimmwinkel aus dieser Differenz durch deren zeitliche Integration ermittelt 
wird. 

Damit steht in vorteilhafter Weise zur Ermittlung des Schwimmwinkels ein einfaches und 
in einem Steuergerat leicht zu implementierendes Verfahren zur Ermittlung des 
Schwimmwinkels zur Verfugung. 

Eine vorteilhafte Ausgestaltung ist dadurch gekennzeichnet, dass die Richtung der uber 
das GPS-System ermittelten Geschwindigkeit durch Ausnutzung des physikalischen 
Doppler-Effekts ermittelt wird. Damit wird eine hohe Prazision der ermittelten 
Geschwindigkeit sichergestellt. 

Die Vorrichtung zur Ermittlung des Schwimmwinkels eines Kraftfahrzeugs umfasst 
einen Gierratensensor zur Ermittlung der Gierrate (cogier) des Kraftfahrzeugs. 

Der Kern der Vorrichtung besteht darin, dass zusatzlich 

ein im Kraftfahrzeug befindlicher GPS-Empfanger zur Ermittlung der Richtung der 
Geschwindigkeit insbesondere im Schwerpunkt des Kraftfahrzeugs durch eine 
Frequenzanalyse der empfangenen Signale und 

Ermittlungsmittel, in denen wenigstens ausgehend von der Gierrate und der Richtung 
der Geschwindigkeit des Kraftfahrzeugs der Schwimmwinkel ermittelt wird 
vorhanden sind. 

Weitere vorteilhafte Ausgestaltungen der Erfindung sind den Unteranspruchen zu 
entnehmen. 



Zeichnung 
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Die Zeichnung besteht aus den Figuren 1 und 2. 

Fig. 1 zeigt den Ablauf des Verfahrens zur Bestimmung des Schwimmwinkels. 
Fig. 2 zeigt den Aufbau der Vorrichtung zur Bestimmung des Schwimmwinkels. 



Ausfuhrungsbeispiele 

In der heutigen Zeit gewinnen Systeme, welche den Fahrzustand eines Fahrzeugs in 
fahrdynamischen Grenzsituationen (d.h. fahrdynamisch kritischen Situationen) 
stabilisieren, zunehmend an Bedeutung. Beispielsweise seien hier Antiblockiersysteme 
(ABS) und Fahrdynamikregelungssysteme (z.B. ESP = ^Electronic Stability Program") 
genannt. Die Sensorik, auf die solche System zugreifen, sind im wesentlichen 

ein Gierratensensor, 

ein Querbeschleunigungssensor, 

Raddrehzahlsensoren, 

ein oder mehrere Bremsdrucksensoren und 

ein Lenkwinkelsensor. 

Mittels dieser Sensoren wird 

der Fahrerwunsch ermittelt und 

der Bewegungszustand des Fahrzeugs bestimmt. 

Der fur die Fahrdynamik relevante Schwimmwinkel wird ublicherweise aus den von 
diesen Sensoren gelieferten Daten geschatzt. Dabei wird unter dem Schwimmwinkel der 
Winkel zwischen der Fahrzeuglangsachse und der Richtung der Geschwindigkeit im 
Schwerpunkt des Fahrzeugs verstanden. 

In der vorliegenden Erfindung wird der Schwimmwinkel mittels einer einzigen am 
Fahrzeug angebrachten GPS-Antenne und eines Gierratensensors ermittelt. Dabei kann 
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der auf diese Art und Weise ermittelte Wert durchaus auch zur Stiitzung bzw. Korrektur 
des aus Sensordaten geschatzten Schwimmwinkels verwendet werden. 

Uber den Dopplereffekt (unter dem Dopplereffekt versteht man die 
Frequenzverschiebung bei einer Relativbewegung von Strahlquelle und Strahlempfanger 
zueinander) kann aus den GPS-Signalen die Relativgeschwindigkeit zwischen der am 
Fahrzeug angebrachten GPS-Antenne und dem entsprechenden GPS-Satelliten berechnet 
werden. Bei direktem Kontakt mit vier Satelliten kann uber die GPS-Sensorik ein 3D- 
Geschwindigkeitsvektor (vx, vx, vz) mit einer Genauigkeit der GroBenordnung 0.1 m/s 
bei einer Ermittlungsfrequenz von 10 Hz ermittelt werden. Die Ermittlung dieses 
Geschwindigkeitsvektors erfolgt dabei durch eine Frequenzanalyse, welche den durch die 
Fahrzeugbewegung auftretenden Dopplereffekt erfasst und auswertet. Im Gegensatz zu 
dieser hochprazisen Geschwindigkeitsbestimmung ist dabei die Ortsbestimmung mittels 
eines GPS-Systems (es wird eine Genauigkeit der GroBenordnung 10 m erreicht) weniger 
genau. 

Es ist wesentlich, dass dabei der Geschwindigkeitsvektor im Schwerpunkt des 
Kraftfahrzeugs (d.h. die Schwerpunktsgeschwindigkeit) ermittelt wird. Dies kann bei 
einem GPS-System (welches auf dem Empfang von durch Satelliten ausgesandten 
Signalen durch eine Antenne und deren Auswertung beruht) wenigstens auf zwei 
verschiedene Arten erreicht werden: 

1 . der GPS-Empfanger liegt in der durch den Fahrzeug schwerpunkt gehenden 
Hochachse des Fahrzeugs . Haufig liegt die durch den Fahrzeugschwerpunkt gehende 
Hochachse in der Nahe des Armaturenbretts. Deshalb bietet sich in diesen Fallen ein 
Einbau des GPS-Empfangers in das Armaturenbrett an. Ein weiterer geeigneter 
Einbauort fur die GPS-Antenne ist die Kontaktlinie zwischen Frontscheibe des 
Fahrzeugs und Karosserie. 

2. Im Falle, dass ein Einbau nahe dem Fahrzeugschwerpunkt nicht moglich ist, konnen 
die vom GPS-Empfanger ermittelten Geschwindigkeitskomponenten in den 
Schwerpunkt transformiert werden. Dies geschieht durch die 
Transformationsvorschriften vx_sp = vx + cogier*Rx und vy_sp = vy - cogier*Ry . 
Dabei sind vx_sp und vy_sp die Geschwindigkeitskomponenten im 
Fahrzeugschwerpunkt, vx und vy sind die Geschwindigkeitskomponenten am 
Einbauort der GPS-Antenne und cogier ist die beispielsweise mit einem 
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Gierratensensor ermittelte Gierrate des Kraftfahrzeugs. Rx bzw. Ry kennzeichnen 
den Abstand in Langs- bzw. Querrichtung des GPS-Empfangers vom 
Fahrzeugsschwerpunkt. Sind die Korrekturterme cogier*Rx und cogier*Ry viel kleiner 
als vx bzw. vy, dann kdnnen sie haufig vernachlassigt werden. 

Im Folgenden wird die Projektion dieses 3D-Geschwindigkeitsvektors auf die x-y-Ebene 
betrachtet, die Geschwindigkeitskomponente in z-Richtung (vz) wird vernachlassigt. Bei 
einer konstanten Geradeausfahrt andert der Vektor weder seinen Betrag noch seine 
Richtung. Bei einer unkritischen Kurvenfahrt mit konstanter Geschwindigkeit dreht sich 
dieser Vektor in der x-y-Ebene mit der Winkel geschwindigkeit cogps mit dem Fahrzeug. 
Im Fahrzeug selbst wird in dieser Situation mit dem Gierratenssensor eine Gierrate 
cogiermess gemessen. 

Dabei haben die GroBen cogps und cogiermess die folgende anschauliche Bedeutung: 

cogps: Diese GroBe gibt die Winkelgeschwindigkeit an, mit der sich der 
Geschwindigkeitsvektor des Fahrzeugschwerpunktes dreht. 

cogiermess: Diese GroBe gibt die mit dem Gierratensensor des Fahrzeugs gemessene 
Gierrate an, d.h. die Winkelgeschwindigkeit, mit der sich die Fahrzeuglangsachse dreht. 

Die im Fahrzeug gemessene Gierrate cogiermess stimmt bei einer ebenen Fahrbahn mit 
cogps uberein, solange kein Schwimmwinkel aufgebaut wird. Weichen die beiden GroBen 
jedoch voneinander ab, dann entspricht die Differenz der zeitlichen Ableitung des 
Schwimmwinkels, d.h. der Anderung des Schwimmwinkel s dp dividiert durch das 
Zeitintervall dt: 
dp/dt = cogier - cogps . 

Bei der GroBe cogier handelt es sich dabei urn den bzgl. Genauigkeit, Empfindlichkeit und 
Querneigung der Fahrbahn korrigierten Wert von cogiermess. Naheres dazu wird bei der 
Beschreibung von Fig. 1 ausgesagt. 

Durch die zeitliche Integration der GroBe dp/dt erhalt man den Schwimmwinkel: 

P = J(cogier - cogps)dt . 

,J" kennzeichnet dabei das Integral symbol. 



-7- 



R. 303847 



Der Ablauf einer Ausfuhrungsform des erfindungsgemaBen Verfahrens zur Bestimmung 
des Schwimmwinkel ist in Fig. 1 dargestellt. 

Dabei wird in Block 101 mit dem Gierra ten sensor die Gierrate cogiermess gemessen. 
Diese GroBe wird dem Verknupfungsblock 103 zugefuhrt. In Block 103 wird die 
Differenz 

cogiermess - cogieroff 

gebildet. Dabei kennzeichnet cogieroff den durch Block 102 bereitgestellten Offsetwert 
der durch den Gierraten sensor gemessenen Gierrate. Das Ausgangssignal von Block 103 
wird dem weiteren Verknupfungsblock 104 zugeleitet. In diesem Block findet eine 
Multiplikation 

cogiersens*(cogiermess - cogieroff) 
start. 

cogiersens ist dabei eine durch Block 105 bereitgestellte dimensionslose GroBe und 
kennzeichnet die Empfindlichkeit des Gierraten sensors. Das Ergebnis von Block 104 
wird Block 106 weitergeleitet. In Block 106 wird der seitliche Neigungswinkel a der 
Fahrbahn bereitgestellt. 

Das Ergebnis von Block 106 wird an Block 107 weitergeleitet. 
In Block 107 wird die gemessene Gierrate bzgl. der Seitenneigung der Fahrbahn 
korrigiert. Das hangt damit zusammen, dass bei einer seitlich geneigten Fahrbahn der 
Gierratensensor nicht die physikalisch vorliegende Gierrate ermittelt, sondern einen zu 
kleinen Wert. 

Die Korrektur in Block 107 lautet: 

cogier = cogiersens*(cogiermess - cogieroff)/cos(oc) . 

An dieser Stelle soil betont werden, dass die Funktion der Blocke 102, 103, 104 und 105 
lediglich in der Korrektur der gemessenen Gierrate cogiermess bzgl. Offset und 
Empfindlichkeit besteht. 

In Block 108 werden uber das GPS-System die Geschwindigkeitskomponenten vx und vy 
ermittelt. Dies geschieht durch Ausnutzung des Dopplereffekts, welcher den 
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Zusammenhang zwischen einer Frequenzanderung und einer Relativbewegung zwischen 
Strahl sender und Strahlempfanger beschreibt. 

Die Ausgangssignale der Blocke 107 (cogier) und 109 (cogps) werden Block 110 
zugefuhrt. In Block 1 10 wird die Differenz 

cogier - cogps gebildet. Diese Differenz wird an Block 1 1 1 weitergeleitet, dort wird ihr der 
Wert ihr der Wert d(3/dt zugewiesen. 

AnschlieBend an Block 1 1 1 wird in Block 1 12 die Grofie dp zeitlich integriert (bzw. 
aufsummiert) und damit steht in Block 1 12 der Schwimmwinkel p zur Verftigung. 

Der Aufbau der Vorrichtung zur Bestimmung des Schwimmwinkels ist in Fig. 2 
dargestellt. 

Dabei kennzeichnet Block 201 einen Gierratensensor, welcher die Gierrate cogiermess 
bzw. cogier ermittelt. Weiter kennzeichnet Block 202 ein GPS-System zum Empfang der 
Geschwindigkeit des Kraftfahrzeugs nach Betrag und Richtung. Die Ausgangssignale 
dieser beiden Blocke werden den Ermittlungsmitteln 203 zugefuhrt. In Block 203 wird 
der Schwimmwinkel ermittelt. Der Schwimmwinkel wird an Block 204 weitergeleitet. 
Bei Block 204 handelt es sich beispielsweise um 

ein Fahrdynamikregelungssystem, welches dann beispielsweise wiederum 

Bremsaktuatoren ansteuert oder 

ein Ruckhaltesystem, bei dem beispielsweise die Ausloseschwellen von reversiblen 
Gurtstraffern reduziert werden oder 

um ein System der pradiktiven Fahrdynamikregelung (z.B. ACC = „Active Cruise 
Control")- 
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Anspruche 

1 . Verfahren zur Ermittlung des Schwimmwinkels (p) eines Kraftfahrzeugs, bei dem 

durch einen Gierra ten sensor die Gierrate (cogier) des Kraftfahrzeugs ermittelt wird 
(101), 

dadurch gekennzeichnet, dass 

die Richtung der Geschwindigkeit (v) insbesondere im Schwerpunkt des 
Kraftfahrzeugs durch eine Frequenzanalyse der durch einen im Kraftfahrzeug 
befindlichen GPS-Empfanger empfangenen Signale ermittelt wird (108) und 
abhangig wenigstens von der Gierrate (cogier) und der Richtung der Geschwindigkeit 
(v) des Kraftfahrzeugs der Schwimmwinkel ((3) ermittelt wird (112). 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass 

aus der uber den GPS-Empfanger ermittelten Richtung der Geschwindigkeit (v) eine 
Winkelgeschwindigkeit (cogps) ermittelt wird und 

die Winkelgeschwindigkeit (cogps) in die Ermittlung des Schwimmwinkels (p) 
eingeht. 

3. Verfahren nach Anspruch 2, dadurch gekennzeichnet, dass 

die Winkelgeschwindigkeit (cogps) die Drehgeschwindigkeit des die Geschwindigkeit 
(v) beschreibenden Vektors beschreibt. 

4. Verfahren nach Anspruch 3, dadurch gekennzeichnet, dass 

die Differenz zwischen der Gierrate (cogier) und der Winkelgeschwindigkeit (cogps) 
ermittelt wird und 

der Schwimmwinkel (p) aus dieser Differenz durch deren zeitliche Integration 
ermittelt wird. 

5. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die Ermittlung der 
Richtung der Geschwindigkeit (v) auf der Ausnutzung des physikalischen Doppler- 
Effekts beruht. 
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6. Vorrichtung zur Ermittlung des Schwimmwinkels ((3) eines Kraftfahrzeugs, welche 

einen Gierraten sensor (201) zur Ermittlung der Gierrate (cogier) des Kraft fahrzeugs 
enthalt, 

dadurch gekennzeichnet, dass 

ein im Kraftfahrzeug befindlicher GPS-Empfanger (202) zur Ermittlung der Richtung 
der Geschwindigkeit (v) insbesondere im Schwerpunkt des Kraftfahrzeugs durch eine 
Frequenzanalyse der empfangenen Signale und 

Ermittlungsmittel (203), in denen wenigstens ausgehend von der Gierrate (cogier) und 
der Richtung der Geschwindigkeit (v) des Kraftfahrzeugs der Schwimmwinkel (p) 
ermittelt wird 
enthalten sind. 

7. Vorrichtung nach Anspruch 6, dadurch gekennzeichnet, dass die Ermittlungsmittel 
(203) so ausgestaltet sind, dass in ihnen 

aus der iiber den GPS-Empfanger (202) ermittelten Geschwindigkeit (v) eine 
Winkelgeschwindigkeit (cogps) ermittelt wird und 

die Winkelgeschwindigkeit (cogps) in die Ermittlung des Schwimmwinkels (P) 
eingeht. 

8. Vorrichtung nach Anspruch 7, dadurch gekennzeichnet, dass 

die Winkelgeschwindigkeit (cogps) die Drehgeschwindigkeit des die Geschwindigkeit 
(v) beschreibenden Vektors beschreibt. 

9. Vorrichtung nach Anspruch 8, dadurch gekennzeichnet, dass die Ermittlungsmittel 
(203) so ausgestaltet sind, dass in ihnen 

die Differenz zwischen der Gierrate (cogier) und der Winkelgeschwindigkeit (cogps) 
ermittelt wird und 

der Schwimmwinkel (p) aus dieser Differenz durch deren zeitliche Integration 
ermittelt wird. 
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01.10.02 Ms 

ROBERT BOSCH GMBH, 70442 Stuttgart 
Zusammenfassung 

Verfahren und Vorrichtung zur Ermittlung des Schwimmwinkels eines Kraftfahrzeugs 

Die Erfindung betrifft ein Verfahren zur Ermittlung des Schwimmwinkels eines 
Kraftfahrzeugs, bei dem durch einen Gierratensensor die Gierrate des Kraftfahrzeugs 
ermittelt wird. 

Der Kern der Erfindung besteht darin, dass 

die Richtung der Geschwindigkeit insbesondere im Schwerpunkt des Kraftfahrzeugs 
durch eine Frequenzanalyse der durch einen im Kraftfahrzeug befindlichen GPS- 
Empfanger empfangenen Signale ermittelt wird und 

abhangig wenigstens von der Gierrate und der Richtung der Geschwindigkeit des 
Kraftfahrzeugs der Schwimmwinkel ermittelt wird. 



(Fig- 1) 
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